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Serial No. : To Be Assigned 
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Assistant Commissioner 

for Patents 
Washington, D.C. 20231 
Box Patent Application 

PRELIMINARY AMENDMENT AND 
37 C.F.R. S 1.125 SUBSTITUTE SPECIFICATIO N STATEMENT 

SIR: 

Please amend the above-identified application before examination, as set forth below. 

IN THE SPECIFICATION AND ABSTRACT : 

In accordance with 37 C.F.R. § 1.121(b)(3), a Substitute Specification (including the 
Abstract, but without claims) accompanies this response. It is respectfully requested that the 
Substitute Specification (including Abstract) be entered to replace the Specification of record, 

IN THE CLAIMS : 

On the first page of the claims, first line, change "What is claimed is:" to: 
- What Is Claimed Is :--. 

Please cancel original claims 1 to 10, without prejudice, in the underlying PCT 
Application No. PCT/DEO 1/0 1276. 
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Please add the following new claims: 



11. (New) A method for controlling a speed of a vehicle, comprising the steps of: 
in the vehicle to be controlled, measuring one of a yaw rate and a rotation rate to 

determine a curvature of a trajectory of the vehicle; 

causing one of a proximity sensor and a position sensor to detect one of at least one 
vehicle traveling ahead and at least some other object within a sensing range, with regard to 
an offset from a travel course of the vehicle to be controlled; 

determining a travel-course offset of a vehicle driving ahead in preset measuring 

cycles; 

delaying the travel-course offset of the vehicle traveling ahead by a predefined time 
lag; and 

ascertaining a historical travel-course offset in accordance with a then active curvature 
of the trajectory of the vehicle to be controlled. 

12. (New) The method according to claim 1 1, wherein: 

the predefined time lag is selected such that the historical travel-course offset 
is determined after approximately half of a distance between the vehicle to be 
controlled and the vehicle driving ahead. 

13. (New) The method according to claim 11, wherein: 

the historical travel-course offset is determined in accordance with the relation 
vc hist ~ yVhist-^dyris^/Z, d hist likewise being one of generated and estimated as a 
historical distance between the vehicle to be controlled and the vehicle driving ahead 
on the basis of a delay. 

14. (New) The method according to claim 1 3, wherein: 

the historical distance is estimated according to the relation d hist = d active - 

vr*t hist . 

15. (New) The method according to claim 12, further comprising the step of: 
supplementing a time span until a maximum value t h(St is reached by a component that 

increases with a duration of observation to form t histMyir 
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16. (New) The method according to claim 1 1 , further comprising the step of: 

at any one time, delaying by a preset value an instantaneous value of curvature of the 
trajectory of the vehicle to be controlled, the delay being considered as well in the 
determination of the historical travel-course offset. 

1 7. (New) The method according to claim 1 1 , further comprising the step of: 

for an active travel-course offset and the historical travel-course offset, determining a 
lane probability of the vehicle driving ahead for at least one of an own lane and adjacent lanes 
of the vehicle to be controlled. 

1 8. (New) The method according to claim 1 7, further comprising the step of: 
mixing two lane probabilities as a function of a quality of one of the historical 

travel-course offset to form a new value. 

19. (New) The method according to claim 1 1, further comprising the step of: 

in the vehicle to be controlled, providing a number of further detection devices for 
measuring positions of objects driving ahead; and 

to select an object driving ahead as a vehicle to which a speed of the vehicle to be 
controlled is to be adapted, evaluating and weighting all results from the further detection 
devices. 

20. (New) The method according to claim 19, wherein: 

the evaluation and weighting are carried out using one of a video camera, a 
satellite-supported navigational system, a system for analyzing fixed destinations, 
and a system for determining a collective yaw rate of objects driving ahead. 

Remarks 

This Preliminary Amendment cancels original claims 1 to 10, without 
prejudice, in the underlying PCT Application No. PCT/DEO 1/0 1276. The Preliminary 
Amendment also adds new claims 1 1-20. The new claims conform the claims to U.S. Patent 
and Trademark Office rules and do not add new matter to the application. 

In accordance with 37 C.F.R. § 1.121(b)(3), the Substitute Specification 
(including the Abstract, but without the claims) contains no new matter. The amendments 
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reflected in the Substitute Specification (including Abstract) are to conform the Specification 
and Abstract to U.S. Patent and Trademark Office rules or to correct informalities. As 
required by 37 C.F.R. § 1.121(b)(3)(iii) and § 1.125(b)(2), a Marked Up Version Of The 
Substitute Specification comparing the Specification of record and the Substitute 
Specification also accompanies this Preliminary Amendment. Approval and entry of the 
Substitute Specification (including Abstract) are respectfully requested. 

The underlying PCT Application No. PCT/DEO 1/0 1276 includes an 
International Search Report, dated August 21, 2001, a copy of which is submitted herewith. 

Applicants assert that the subject matter of the present application is new, 
non-obvious, and useful. Prompt consideration and allowance of the application are 
respectfully requested. 



Respectfully Submitted, 
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[10191/2098] 



METHOD FOR CONTROLLING THE SPEED OF A VEHICLE 



Field Of The Invention 



The present invention relates to a method for controlling the speed of a vehicle, particularly 
under consideration of vehicles driving ahead. 

5 

Background Information 

S3 From German Published Patent Application No. 42 42 700, it is known to mount a radar or 

ill infrared sensor on a vehicle to detect vehicles driving ahead. This radar sensor can be, for 

10;fr example, a module of a vehicle comfort and convenience system ACC (adaptive cruise 

•4* control), in which information pertaining to the distance and the relative speed of the vehicle 

i - : 
"•pa* 

; S with respect to other vehicles and information on road conditions are continually processed. 

O The basic functions of the above described system relate to the control of the vehicle speed, 
15Q either to a setpoint value, here the desired speed, or to the speed of a vehicle driving ahead, in 
the case that the latter is traveling at a slower speed than the desired speed and is within the 
sensing range of the radar sensor. As mentioned above, this sensor can be, for example, a 
component of a microwave radar or of an infrared lidar and, to that end, it measures the 
distance, the relative speed, and the angle of objects, particularly of vehicles driving ahead 
20 within the sensing range. 



From German Patent No. 197 22 947, a method is known, where, in addition to measuring the 
quantities described above, the ACC system also includes the future travel-course progression 
of the vehicle, along with the ACC system, in the control in order to determine the future 
25 travel corridor. For this, the future travel-course range of at least one vehicle driving ahead is 
determined, and a lateral offset is then ascertained for all detected vehicles. Given 
steady-state curvature conditions of the roadway, i.e., in a linear portion or in the region of 
constant curvature of a curve, the future travel corridor is also able to be easily determined 
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using the known method, with the aid of a well-adjusted yaw-rate or rotation-rate signal. 



From the yaw rate of the ACC vehicle, the curvature of the roadway and, therefore, also the 
travel-course offset of a vehicle traveling ahead can be determined here, using generally 
5 known method steps. If this travel-course offset is smaller in terms of absolute value than a 
predefined width of the travel corridor, then one can infer that the vehicle traveling ahead is 
located in the travel corridor of the ACC vehicle. When working with changing conditions, 
particularly in the beginning curve region, however, one is normally no longer able to 
correctly determine the association with the travel corridor, so that it can happen that a 
1 0 vehicle driving ahead in the right, adjacent lane, near the beginning of a left curve, is 

incorrectly attributed to the travel corridor. This leads to faulty control reactions, the cause 
Q here being the mistaken curvature prediction, since the ascertained curvature is always 
£j| specific to the current instant and, therefore, the reaction to a change in curvature is always 
m too late. 



15^ 



Summary Of The Invention 



U A method for controlling the speed of a vehicle of the type mentioned at the outset, where, in 
q the vehicle to be controlled, the yaw rate or rotation rate is measured, in particular to 
20 " determine the curvature of the vehicle's own travel trajectory, and where, using a proximity 
sensor or position sensor, at least one vehicle traveling ahead or at least some other object 
within a sensor's sensing range is detected with regard to an offset from the travel course of 
the vehicle to be controlled, is advantageously further refined in accordance with the present 
invention. 

25 

As already mentioned at the outset, curvature k of the roadway may be calculated in a simple 
manner from the measured yaw rate of the ACC vehicle to be controlled using generally 
known method steps in that the yaw rate is divided by the speed, and, using that, the 
travel-course offset yc of a vehicle traveling ahead may also be determined. Specifically, 
30 travel-course offset yc may by determined by the following formula: 

yc = yv - k*d 2 /2, 
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quantity yv being the measured lateral offset, without allowing for curvature k, and d being 
the distance between the vehicle to be controlled and the measured vehicle driving ahead. 

If this travel-course offset yc is smaller in terms of absolute value than a predefined width 
y lane , then one may infer that the object or the vehicle is located in the travel corridor of the 
ACC vehicle, y lane corresponding approximately to one half of a lane width. 

In accordance with the present invention, travel-course offset yc of a vehicle driving ahead, 
determined in preset measuring cycles, is delayed by a predefined time lag, and using the 
instantaneous curvature k of the travel trajectory of the vehicle to be controlled, a historical 
travel-course offset yc hist is ascertained. In this context, the delay may advantageously be 
selected such that historical travel-course offset yc hisl is determined after approximately half 
of the distance between the vehicle to be controlled and the measured vehicle. 

Therefore, alternatively to the generally known method of looking ahead using video-based 
lane detection or navigational systems, the method according to the present invention for 
controlling an ACC vehicle permits, in a simple manner, a relatively fast and 
simple-to-implement historical comparison between the position and travel trajectory of the 
vehicles. Instead of a costly, continuous transformation of the measured data, the present 
invention provides, in simplified fashion, for measured lateral offset yv to be delayed by 
about time span t hist3 commensurate with half of the time span between the vehicles. 

From this so delayed value yv hist , as above, using active curvature k, the so-called historical 
travel-course offset yc^ is now determined in accordance with the relation: 

y^st = yVhisrk*d hist 2 /2 

d hist being generated or estimated, likewise on the basis of a delay, as the historical distance 
between the vehicle to be controlled and the measured vehicle. For example, in accordance 
with the relation 

^hist = ^active " VT *^hisf 
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Thus, distance takes into consideration the change in distance in response to speed 
differences. In illustrative terms, the mechanism functions as follows: the curvature 
determination is made approximately at the middle of the distance between the ACC vehicle 
and the measured object, although delayed by t hist . Even when working with changing 
5 curvatures, the average curvature is a good estimation here and allows a quite precise 
determination of travel-course offset. 

To avoid unwanted transient effects in those cases where the object had not yet been 
measured for the length of time span thist and, consequently, no historical lateral offsets exist, 
10 it is advantageous when a dynamically increasing delay time t^^ takes the place of time 
t hist , the time span until maximum value t hist is reached being supplemented by the dynamic 
Q component that increases with the duration of observation. Until this maximum value is 
hf reached, the quality of the thus calculable yc hisl is somewhat lower, but this value is always 
l f~-; ready as a transitional value. 

; ~ In addition, a filtering is advantageous to compensate for short-term curvature fluctuations 
y caused by steering motion or signal noise. Since this filtering likewise delays the active signal 
2 by t filter , the delay in the yv values must likewise last longer by approximately this value. The 
□ delay may be advantageously further modified, for example, by filter times of active 
20 ~ curvature signal k. In this connection, the instantaneous value of curvature k of the travel 
trajectory of the vehicle to be controlled, at any one time, is delayed by a preset value for 
averaging purposes, this delay being considered as well in the determination of historical 
travel-course offset yc hist . 

25 Although the delay times are known, so that t hlsl is generated from the sum of half of the time 
gap and the filter time, such modifications of time span t hisl may be useful in order to achieve 
a functional optimum by way of a total adjustment. This applies, in particular, when the 
quantities are not only filtered by a delay element, but are also averaged via low-pass-type 
filters. The latter is also used here for reducing measuring fluctuations. Delay element and 

30 averaging filter may be combined in simple fashion, for example, by using filters having a 
most constant possible group delay, e.g., Bessel filters or series-connected filters having a 
critical attenuation. 
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In summary, the method of the present invention enables historical travel-course offsets to be 
generated in simple fashion, in particular by combining averaging and delay, without 
necessitating a costly storing of lane data or transformation of such stored data. A rapid result 
is achieved, since one only has to wait for about half of the time gap up until the result. 

5 

To obtain a still further improved method for predicting the path of the vehicle to be 
controlled, it is also possible for a number of further detection devices for determining the 
travel-course offsets of objects traveling ahead to be present in the vehicle to be controlled. 
All results of these detection devices may then be analyzed and weighted. The analysis and 
1 0 weighting may preferably be carried out using a video camera, a preferably 

, , satellite-supported navigational system, a set-up for analyzing fixed destinations, or a set-up 

y for determining a collective yaw or rotation rate of the objects driving ahead. 

M= 

J Brief Description Of The Drawings 
15? 

j_ Figure 1 shows a sketch of a curved roadway path, including a vehicle whose speed is to be 

Q 

g controlled, and further objects. 

□ Figure 2 shows a sketch of a curved roadway path, including a vehicle whose speed is to be 
20 controlled, and further objects at various points in time. 

Figure 3 shows a diagram of the output signal of a delay-producing filter. 

Figure 4 shows an overview diagram of a lane probability with respect to objects located in a 
25 travel corridor. 

Figure 5 shows a diagram for assessing the various lane probabilities. 

Figure 6 shows a block diagram relating to the analysis and weighting of various detection 
30 methods used to detect objects moving ahead. 

Detailed Description 
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Figure 1 shows an ACC vehicle 1 to be controlled, which is located on a roadway 2 having a 
plurality of lanes. Vehicle 1 has, for example, a radar sensor 3 having a radar detection range 
4; other detection set-ups are also mountable on vehicle 1, such as video or navigational 
devices, which may be used to detect roadway 2 or the area surrounding the roadway. 
Situated on roadway 2 as an object driving ahead is a vehicle 5, in reality, a plurality of such 
objects being present at various distances and at different speeds. 

The ACC system in vehicle 1 includes a control system (not explained in further detail here) 
for influencing speed, and a plurality of sensors, such as a yaw-rate or rotation-rate sensor, a 
steering-angle sensor, wheel-speed sensors, or a transversal-acceleration sensor. A dot-dash 
line 6 represents the future desired travel-course progression, i.e., the travel trajectory of 
vehicle 1, and the two lines 7 show the future travel-course range or travel corridor. A line 
segment 9 indicates the lateral or travel-course offset of vehicle 5 driving ahead with respect 
to the travel course of vehicle 1 . 

The assumption is made in the following, with reference to Figures 2 and 3, that, to correct 
the curvature of travel trajectory 6 of vehicle 1 in light of a curvature to be expected of 
roadway 2, a historical travel-course offset or lateral offset is used in the calculation. 

In accordance with the exemplary embodiment illustrated in the drawing, travel-course offset 
yc of a vehicle 8 driving ahead is delayed by a predefined time span, and using the then active 
curvature k, a historical travel-course offset ychist is determined at instants t t , t 2 , and t 3 of 
travel trajectory 6. In this context, the delay may advantageously be selected such that 
historical travel-course offset yc^ is defined approximately at half of the distance between 
vehicle 1 to be controlled and vehicle 5 to be measured. 

From this thus delayed value yv hist , so-called historical travel-course offset yc Wst is now 
determined, as above, using active curvature k, according to the relation 

ychist = yvhisf k*d h ist 2 /2- 

Figure 3 shows a diagram of the output signal of a delay-producing filter. The time is shown 
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in seconds on the horizontal axis, and the characteristic curve of an output signal is shown on 
the vertical without units/theoretically. The illustrated, exemplary characteristic curve shows 
a maximum of the output signal in the region of approx. 0.8 seconds. This maximum must be 
appropriately adapted to the desired delay. 

5 

The following describes a method for performing the previously described calculation, with 
the involvement of historical travel-course offset yc hi3t for predicting a travel course. The 
selected abbreviations represent the common short forms of the corresponding physical 
quantities used for inputting into a data-processing system. For the sake of simplicity, the 
10 trajectory is assumed in this case to be a piece- wise constant parabola. The parabola curvature 
is defined approximately in the middle of the section between object 5 and vehicle 1 
□ (compare Figure 2). Since the now single trajectory coefficient is defined already when the 
2 middle is reached, a delay in the object lateral offsets yv is also only necessary up to the 
1 middle. The time delay is achieved, for example, by a triply cascaded low-pass filter (not 
1 5P shown here) having a dynamic time constant Tauy for improving the transient response. Here, 
7 the following relations apply: 

O Tauy^) = MIN(TauyMax(y, TauyMax^O+T^J; 
20 y in the case that a valid measured value exists for the object, otherwise it follows that 
Tauy(tj) - MAX(0,TauyMax(t J . 1 )- 1^/2) 
where 

25 

Tauy(t j )MAX = fTauyd * (d^/vRef^)) + fTauyKap * TauKap. 

The filtering using the three low-pass stages yields a total group delay of 3Tauy(t,). Thus, in 
three measuring cycles, one obtains the following lateral offsets: 

30 

yvl(tj) = (T cycle /Tauy(t3) * (yvft) - yvl^)), 
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yv2(t,) = (T^u/TauyCtj) * (yvl^) - yv^tj.,)), 



yv3(tj) = (T cyde /Tauy(tj) * (yv2(tj) - yv3(tj- 1)). 

5 From output value yv3(tj) of the filter, with the aid of trajectory curvature k Traj (tj) (previously 
the value = k), the historical lateral offset to the middle of the course may be calculated as 
follows: 

ycHistCt^ yv3(t,) - k Traj *(d(tj)- vrOj)* 3TauDy(tj)) 2 /2. 

10 

In this case, vr(tj) * 3Tauy(tj) corrects the active distance to historical reference point tj - 
M 3Tauy(t,). 

h* As a further characteristic quantity for the quality of the historical lateral offset, quantity 
lfjul ycHistQ is used; it is calculated from angular quality Qalpha (e.g. = 1) and from the 
% observation duration for the calculation of the historical lateral offset: 

% ycHistQ(tj)= MIN(l, ycHistQO,.,) + Qalpha * 
g T cycl /IauHist(t,)) 
2(P respectively, 

TauHist(tj)= fTauHist * (d(tj)/ v^tj) ), 

in the case that an object was measured, and a valid travel-course offset is at hand. Quantity 
25 fTauHist stands here for the fractional portion of the time gap, starting from which a 
steady-state performance is assumed. Otherwise, it holds that: 

ycHistQ(t,)= M1N(0, ycHistQ(^ t ) - Tcycle/TauHist^)). 

30 Since the historical lateral offset is not available in sufficient quality until a relatively long 
waiting time has elapsed, on the basis of active lateral offset yv and the active travel-course 
curvature, an active travel-course offset yc Act is determined, which is able to provide a lateral 
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travel-course offset as soon as there is a first measurement of an object: 



yC A ct " yV ' yVcourse = YV - d 2 * kc ouree /2. 

5 Figure 4 is a graphic representation illustrating the lane probability of the measured objects, 
active lane probability spwAct and historical lane probability spwHist following in parallel, 
in the same manner, for active lateral offset yc Act and for historical lateral offset yc Hi st- 

As is apparent from Figure 4, the basis of the previously mentioned lane probability 
10 determination is a surface having constant width L. Within this surface, a positive lane 
lmJL probability is assigned, while outside of it, it becomes negative. The highest probability is 
P assigned when yc is situated within the inner surface. 

2; Similarly to the generally known fuzzy logic, the transitional region may be selected to be 
15 J fuzzy, making it possible to determine a lane probability of -1 to + 1. The width of 

a_ transitional region spw advantageously increases in response to a large distance. 

Q 

; ^ A mixture of the described lane probabilities is shown in a diagram according to Figure 5. 

3 The two lane probabilities spwAct and spwHist are weighted as a function of the quality of 
20 historical lateral offset ycHistQ in the time Tauy and mixed to form a new value spw. 

Weighting factors f Act and f act +fHi St from the diagram according to Figure 5 are generated as 
follows. f Hist for ycHistQ is large in the case that the observation time corresponds 
approximately to TauyMax. f Act may be constant or otherwise determined. 

25 If, in this case, yc Act and yc Hlst point to different travel lanes, then the values compensate for 
one another in accordance with the weightings f Act and f Hlst . If, on the other hand, they are on 
the same lane, then they reinforce one another up to the maximum value f Act +f His t- 

Figure 6 shows a block diagram 40, which indicates various possibilities for detecting and 
30 evaluating object in travel-course progression k of an ACC vehicle, which may also be used 

in different combinations, individually or together. In left branch 41, a calculation is shown of 
a future travel-course progression by adding the vehicle's own trajectory from the vehicle's 
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own yaw rate, to a collective yaw rate in a block 42. In a block 43, by consulting the active 
object data, a decision may now be made as to whether a detected vehicle is located in the 
vehicle's own calculated travel corridor and, therefore, comes under consideration as an 
object to which the vehicle's own speed should be adapted. If this is answered in the 
affirmative, the actual control may be carried out in a control system 44. 

For this, in a parallel branch 45, it is intended for a video system 46 to be present, which 
likewise is able to define the vehicle's own travel corridor and detect an object driving ahead 
as a control object. 

In a further branch 47, a navigational system 48 is provided, which, with knowledge of the 
vehicle's own position and, under consideration of existing map material, is able to effect the 
same control mechanisms as previously described. 

In a further branch 49, in a module 50, a travel course prediction may be made for ACC 
vehicle 1 , which, in the calculation, considers the previously described, historical, lateral 
offset between ACC vehicle 1 and a detected object (vehicle 5,8). 

In another parallel branch 51, in a module 52, a travel course determination may also be made 
using a travel-course offset ascertained by interpreting the position of fixed destinations, for 
example at the edge of the roadway. 

In actual control system 44, by analyzing the results from the calculations of individual 
branches 41, 45, 47, 49, and 51, a final decision may now be made with respect to the 
selection of the vehicle driving ahead, if indicated, including a weighting of the individual 
results, to which the ACC vehicle adapts its speed. 
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Abstract Of The Disclosure 



A method for controlling the speed of a vehicle is proposed, where, in the vehicle to be 
controlled, the yaw rate or rotation rate is measured, in particular to determine the curvature 
of the vehicle's own travel trajectory, and where, using a proximity sensor or position sensor, 
at least one vehicle traveling ahead or at least some other object within a sensor's sensing 
range is detected, particularly with regard to an offset from the travel course of the vehicle to 
be controlled. By delaying the travel-course offset of a vehicle driving ahead, determined in 
preset measuring cycles, by a predefined time span, and by using the then instantaneous 
curvature of the travel trajectory, a historical travel-course offset is ascertained, one is able to 
simply and rapidly predict the travel course of the vehicle to be controlled. 
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[10191/2098] 

METHOD FOR CONTROLLING THE SPEED OF A VEHICLE 
Fii*M ©f The Invention 

The present invention [is directed] relates to a method for controlling the speed of a vehicle, 
particularly under consideration of vehicles driving ahead, [in accordance with the definition 
of the species in the main claim] 

Background Information 

From [German laid open print DE] German Published Patent Application No. 42 42 700 
[Al], it is known to mount a radar or infrared sensor on a vehicle to detect vehicles driving 
ahead. This radar sensor can be, for example, a module of a vehicle comfort and convenience 
system ACC (adaptive cruise control), in which information pertaining to the distance and the 
relative speed of the vehicle with respect to other vehicles and information on road conditions 
are continually processed. 

The basic functions of the above described system relate to the control of the vehicle speed, 
either to a setpoint value, here the desired speed, or to the speed of a vehicle driving ahead, in 
the case that the latter is traveling at a slower speed than the desired speed and is within the 
sensing range of the radar sensor. As mentioned above, this sensor can be, for example, a 
component of a microwave radar or of an infrared lidar and, to that end, it measures the 
distance, the relative speed, and the angle of objects, particularly of vehicles driving ahead 
within the sensing range. 

From German Patent [DE] No. 197 22 947 [CI], a method is known, where, in addition to 
measuring the quantities described above, the ACC system also includes the future 
travel-course progression of the vehicle, along with the ACC system, in the control in order to 
determine the future travel corridor. For this, the future travel-course range of at least one 
vehicle driving ahead is determined, and a lateral offset is then ascertained for all detected 
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vehicles. Given steady-state curvature conditions of the roadway, i.e., in a linear portion or in 
the region of constant curvature of a curve, the future travel corridor is also able to be easily 
determined using the known method, with the aid of a well-adjusted yaw-rate or rotation-rate 
signal. 

From the yaw rate of the ACC vehicle, the curvature of the roadway and, therefore, also the 
travel-course offset of a vehicle traveling ahead can be determined here, using generally 
known method steps. If this travel-course offset is smaller in terms of absolute value than a 
predefined width of the travel corridor, then one can infer that the vehicle traveling ahead is 
located in the travel corridor of the ACC vehicle. When working with changing conditions, 
particularly in the beginning curve region, however, one is normally no longer able to 
correctly determine the association with the travel corridor, so that it can happen that a 
vehicle driving ahead in the right, adjacent lane, near the beginning of a left curve, is 
incorrectly attributed to the travel corridor. This leads to faulty control reactions, the cause 
here being the mistaken curvature prediction, since the ascertained curvature is always 
specific to the current instant and, therefore, the reaction to a change in curvature is always 
too late. 

Summary [of the] Of The Invention 

A method for controlling the speed of a vehicle of the type mentioned at the outset, where, in 
the vehicle to be controlled, the yaw rate or rotation rate is measured, in particular to 
determine the curvature of the vehicle's own travel trajectory, and where, using a proximity 
sensor or position sensor, at least one vehicle traveling ahead or at least some other object 
within a sensor's sensing range is detected with regard to an offset from the travel course of 
the vehicle to be controlled, is advantageously further refined in accordance with the present 
invention [by the characterizing features of the main claim]. 

As already mentioned at the outset, curvature k of the roadway may be calculated in a simple 
manner from the measured yaw rate of the ACC vehicle to be controlled using generally 
known method steps in that the yaw rate is divided by the speed, and, using that, the 
travel-course offset yc of a vehicle traveling ahead may also be determined. Specifically, 
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travel-course offset yc may by determined by the following formula: 
yc - yv - k*d 2 /2, 

quantity yv being the measured lateral offset, without allowing for curvature k, and d being 
the distance between the vehicle to be controlled and the measured vehicle driving ahead. 

If this travel-course offset yc is smaller in terms of absolute value than a predefined width 
y lane , then one may infer that the object or the vehicle is located in the travel corridor of the 
ACC vehicle, y lanc corresponding approximately to one half of a lane width. 

In accordance with the present invention, travel-course offset yc of a vehicle driving ahead, 
determined in preset measuring cycles, is delayed by a predefined time lag, and using the 
instantaneous curvature k of the travel trajectory of the vehicle to be controlled, a historical 
travel-course offset yc hist is ascertained- In this context, the delay may advantageously be 
selected such that historical travel-course offset yc^ is determined after approximately half 
of the distance between the vehicle to be controlled and the measured vehicle. 

Therefore, alternatively to the generally known method of looking ahead using video-based 
lane detection or navigational systems, the method according to the present invention for 
controlling an ACC vehicle permits, in a simple manner, a relatively fast and 
simple-to-implement historical comparison between the position and travel trajectory of the 
vehicles. Instead of a costly, continuous transformation of the measured data, the present 
invention provides, in simplified fashion, for measured lateral offset yv to be delayed by 
about time span t hist , commensurate with half of the time span between the vehicles. 

From this so delayed value yv hist , as above, using active curvature k, the so-called historical 
travel-course offset yc hist is now determined in accordance with the relation: 

yc hi st == yvhist-k*d hist 2 /2 

d,^ being generated or estimated, likewise on the basis of a delay, as the historical distance 
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between the vehicle to be controlled and the measured vehicle. For example, in accordance 
with the relation 

d hist = dactive - VT*t hist . 

Thus, distance d hist takes into consideration the change in distance in response to speed 
differences. In illustrative terms, the mechanism functions as follows: the curvature 
determination is made approximately at the middle of the distance between the ACC vehicle 
and the measured object, although delayed by t hist . Even when working with changing 
curvatures, the average curvature is a good estimation here and allows a quite precise 
determination of travel-course offset. 

To avoid unwanted transient effects in those cases where the object had not yet been 
measured for the length of time span thist and, consequently, no historical lateral offsets exist, 
it is advantageous when a dynamically increasing delay time t hlst/dyn takes the place of time 
t hist , the time span until maximum value t hlst is reached being supplemented by the dynamic 
component that increases with the duration of observation. Until this maximum value is 
reached, the quality of the thus calculable yc hist is somewhat lower, but this value is always 
ready as a transitional value. 

In addition, a filtering is advantageous to compensate for short-term curvature fluctuations 
caused by steering motion or signal noise. Since this filtering likewise delays the active signal 
by t mter , the delay in the yv values must likewise last longer by approximately this value. The 
delay may be advantageously further modified, for example, by filter times of active 
curvature signal k. In this connection, the instantaneous value of curvature k of the travel 
trajectory of the vehicle to be controlled, at any one time, is delayed by a preset value for 
averaging purposes, this delay being considered as well in the determination of historical 
travel-course offset yc hist . 

Although the delay times are known, so that t hist is generated from the sum of half of the time 
gap and the filter time, such modifications of time span t hlst may be useful in order to achieve 
a functional optimum by way of a total adjustment. This applies, in particular, when the 
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quantities are not only filtered by a delay element, but are also averaged via low-pass-type 
filters. The latter is also used here for reducing measuring fluctuations. Delay element and 
averaging filter may be combined in simple fashion, for example, by using filters having a 
most constant possible group delay, e.g., Bessel filters or series-connected filters having a 
critical attenuation. 

In summary, the method of the present invention enables historical travel-course offsets to be 
generated in simple fashion, in particular by combining averaging and delay, without 
necessitating a costly storing of lane data or transformation of such stored data. A rapid result 
is achieved, since one only has to wait for about half of the time gap up until the result. 

To obtain a still further improved method for predicting the path of the vehicle to be 
controlled, it is also possible for a number of further detection devices for determining the 
travel-course offsets of objects traveling ahead to be present in the vehicle to be controlled. 
All results of these detection devices may then be analyzed and weighted. The analysis and 
weighting may preferably be carried out using a video camera, a preferably 
satellite-supported navigational system, a set-up for analyzing fixed destinations, or a set-up 
for determining a collective yaw or rotation rate of the objects driving ahead. 

[These and other features of preferred embodiments of the invention are derived from the 
claims, as well as from the specification and the drawings, it being possible for the individual 
features to be realized individually or multiply in the form of subcombinations in the specific 
embodiment of the present invention and in other areas, and to constitute advantageous and 
patentable embodiments, for which protection is claimed here.] 

Brief Description [of the] Of The Drawings 

[The method according to the present invention for controlling the speed of a vehicle, under 
consideration of objects driving ahead, is elucidated on the basis of the drawing, whose 
figures show:] 

Figure 1 shows a sketch of a curved roadway path, including a vehicle whose speed is to be 
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controlled, and further objects[;]. 

Figure 2 shows a sketch of a curved roadway path, including a vehicle whose speed is to be 
controlled, and further objects at various points in time[;]. 

Figure 3 shows a diagram of the output signal of a delay-producing filter[;]. 

Figure 4 shows an overview diagram of a lane probability with respect to objects located in a 
travel corridorf;]. 

Figure 5 shows a diagram for assessing the various lane probabilities^ and]. 

Figure 6 shows a block diagram relating to the analysis and weighting of various detection 
methods used to detect objects moving ahead. 

Detailed Description 

Figure 1 shows an ACC vehicle 1 to be controlled, which is located on a roadway 2 having a 
plurality of lanes. Vehicle 1 has, for example, a radar sensor 3 having a radar detection range 
4; other detection set-ups are also mountable on vehicle 1, such as video or navigational 
devices, which may be used to detect roadway 2 or the area surrounding the roadway. 
Situated on roadway 2 as an object driving ahead is a vehicle 5, in reality, a plurality of such 
objects being present at various distances and at different speeds. 

The ACC system in vehicle 1 includes a control system (not explained in further detail here) 
for influencing speed, and a plurality of sensors, such as a yaw-rate or rotation-rate sensor, a 
steering-angle sensor, wheel-speed sensors, or a transversal-acceleration sensor. A dot-dash 
line 6 represents the future desired travel-course progression, i.e., the travel trajectory of 
vehicle 1, and the two lines 7 show the future travel-course range or travel corridor. A line 
segment 9 indicates the lateral or travel-course offset of vehicle 5 driving ahead with respect 
to the travel course of vehicle 1 . 
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The assumption is made in the following, with reference to Figures 2 and 3, that, to correct 
the curvature of travel trajectory 6 of vehicle 1 in light of a curvature to be expected of 
roadway 2, a historical travel-course offset or lateral offset is used in the calculation. 

In accordance with the exemplary embodiment illustrated in the drawing, travel-course offset 
yc of a vehicle 8 driving ahead is delayed by a predefined time span, and using the then active 
curvature k, a historical travel-course offset ychist is determined at instants t l5 t 2 , and t 3 of 
travel trajectory 6. In this context, the delay may advantageously be selected such that 
historical travel-course offset yc hist is defined approximately at half of the distance between 
vehicle 1 to be controlled and vehicle 5 to be measured. 

From this thus delayed value yv hi5t , so-called historical travel-course offset yc hist is now 
determined, as above, using active curvature k, according to the relation 

ychist = yvhisr k*d hlsl 2 /2. 

Figure 3 shows a diagram of the output signal of a delay-producing filter. The time is shown 
in seconds on the horizontal axis, and the characteristic curve of an output signal is shown on 
the vertical without units/theoretically. The illustrated, exemplary characteristic curve shows 
a maximum of the output signal in the region of approx. 0.8 seconds. This maximum must be 
appropriately adapted to the desired delay. 

The following describes a method for performing the previously described calculation, with 
the involvement of historical travel-course offset yc hist for predicting a travel course. The 
selected abbreviations represent the common short forms of the corresponding physical 
quantities used for inputting into a data-processing system. For the sake of simplicity, the 
trajectory is assumed in this case to be a piece-wise constant parabola. The parabola curvature 
is defined approximately in the middle of the section between object 5 and vehicle 1 
(compare Figure 2). Since the now single trajectory coefficient is defined already when the 
middle is reached, a delay in the object lateral offsets yv is also only necessary up to the 
middle. The time delay is achieved, for example, by a triply cascaded low-pass filter (not 
shown here) having a dynamic time constant Tauy for improving the transient response. Here, 
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the following relations apply: 



Tauy(^) = MIN(TauyMax(tj), TauyMax(t i . 1 )+T cycle ); 
5 in the case that a valid measured value exists for the object, otherwise it follows that 
Tauyft) = MAXCO^auyMax^)- T cyclc /2) 
where 

10 

i*t Tauy^MAX = fTauyd * (d^VvRef^tj)) + fTauyKap * TauKap. 

^ The filtering using the three low-pass stages yields a total group delay of 3Tauy(tj). Thus, in 
M: three measuring cycles, one obtains the following lateral offsets: 
Iff 

;L yvlft) = (T cyc]e /Tauy(t,) * (yv(tj) - yvl(t y d)> 

j yv2(t!) = (T^/Tauy^) * (yvlft) - ^2^.,)), 

20 yv3(tj) = (T cyc)c /Tauy(tj) * (yv2(tj) - yv3(tj- 1 )). 

From output value yv3(tj) of the filter, with the aid of trajectory curvature k Traj (tj) (previously 
the value = k), the historical lateral offset to the middle of the course may be calculated as 
follows: 

25 

ycHist(t,)= yv3(t,) - k Traj *(d(t,)- vr^)* 3TauDy(t,)) 2 /2. 

In this case, vr(tj) * 3Tauy(t,) corrects the active distance to historical reference point t, 
-3Tauy(tj). 

30 

As a further characteristic quantity for the quality of the historical lateral offset, quantity 
ycHistQ is used; it is calculated from angular quality Qalpha (e.g. = 1) and from the 
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observation duration for the calculation of the historical lateral offset: 

ycHistQ(tj)= MIN(1 , ycHistQOj.O + Qalpha * 

T^/TauHist^)) 

respectively, 

TauHist(tj)= fTauHist * (d(tj)/ v^tj) ), 

in the case that an object was measured, and a valid travel-course offset is at hand. Quantity 
fTauHist stands here for the fractional portion of the time gap, starting from which a 
steady-state performance is assumed. Otherwise, it holds that: 

ycHistQ(tj)= MIN(0, ycHistQ^.,) - Tcycle/TauHist^)). 

Since the historical lateral offset is not available in sufficient quality until a relatively long 
waiting time has elapsed, on the basis of active lateral offset yv and the active travel-course 
curvature, an active travel-course offset yc Act is determined, which is able to provide a lateral 
travel-course offset as soon as there is a first measurement of an object: 

yC A ct = YV - yVcourse - Yv - d 2 * kc ourse /2. 

Figure 4 is a graphic representation illustrating the lane probability of the measured objects, 
active lane probability spwAct and historical lane probability spwHist following in parallel, 
in the same manner, for active lateral offset yc Act and for historical lateral offset yc Hlst . 

As is apparent from Figure 4, the basis of the previously mentioned lane probability 
determination is a surface having constant width L. Within this surface, a positive lane 
probability is assigned, while outside of it, it becomes negative. The highest probability is 
assigned when yc is situated within the inner surface. 

Similarly to the generally known fuzzy logic, the transitional region may be selected to be 
fuzzy, making it possible to determine a lane probability of -1 to + 1 . The width of 
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transitional region spw advantageously increases in response to a large distance. 

A mixture of the described lane probabilities is shown in a diagram according to Figure 5. 
The two lane probabilities spw Act and spwHist are weighted as a function of the quality of 
historical lateral offset ycHistQ in the time Tauy and mixed to form a new value spw. 
Weighting factors f Act and f act +f His t from the diagram according to Figure 5 are generated as 
follows. f His t for ycHistQ is large in the case that the observation time corresponds 
approximately to TauyMax. f Acl may be constant or otherwise determined. 

If, in this case, yc Act and yc His t point to different travel lanes, then the values compensate for 
one another in accordance with the weightings f Act and f Hist . If, on the other hand, they are on 
the same lane, then they reinforce one another up to the maximum value f Act +f Hist . 

Figure 6 shows a block diagram 40, which indicates various possibilities for detecting and 
evaluating object in travel-course progression k of an ACC vehicle, which may also be used 
in different combinations, individually or together. In left branch 41, a calculation is shown of 
a future travel-course progression by adding the vehicle's own trajectory from the vehicle's 
own yaw rate, to a collective yaw rate in a block 42. In a block 43, by consulting the active 
object data, a decision may now be made as to whether a detected vehicle is located in the 
vehicle's own calculated travel corridor and, therefore, comes under consideration as an 
object to which the vehicle's own speed should be adapted. If this is answered in the 
affirmative, the actual control may be carried out in a control system 44. 

For this, in a parallel branch 45, it is intended for a video system 46 to be present, which 
likewise is able to define the vehicle's own travel corridor and detect an object driving ahead 
as a control object. 

In a further branch 47, a navigational system 48 is provided, which, with knowledge of the 
vehicle's own position and, under consideration of existing map material, is able to effect the 
same control mechanisms as previously described. 

In a further branch 49, in a module 50, a travel course prediction may be made for ACC 
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vehicle 1, which, in the calculation, considers the previously described, historical, lateral 
offset between ACC vehicle 1 and a detected object (vehicle 5, 8). 

In another parallel branch 51, in a module 52, a travel course determination may also be made 
using a travel-course offset ascertained by interpreting the position of fixed destinations, for 
example at the edge of the roadway. 

In actual control system 44, by analyzing the results from the calculations of individual 
branches 41 , 45, 47, 49, and 51, a final decision may now be made with respect to the 
selection of the vehicle driving ahead, if indicated, including a weighting of the individual 
results, to which the ACC vehicle adapts its speed. 
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Abstract Of The Disclosure 



A method for controlling the speed of a vehicle [(1)] is proposed, where, in the vehicle [(1)] 
to be controlled, the yaw rate or rotation rate is measured, in particular to determine the 
curvature [(k)] of the vehicle's own travel trajectory, and where, using a proximity sensor or 
position sensor[(6)], at least one vehicle [(5,8)] traveling ahead or at least some other object 
within a sensor's sensing range [(7)] is detected, particularly with regard to an offset from the 
travel course of the vehicle to be controlled. By delaying the travel-course offset [(yc)] of a 
vehicle [(5)] driving ahead, determined in preset measuring cycles, by a predefined time 
span[(thist)], and by using the then instantaneous curvature [(k)] of the travel trajectory, a 
historical travel-course offset [(ychist)] is ascertained, one is able to simply and rapidly 
predict the travel course of the vehicle [(1)] to be controlled. 
[(Figure 1)] 
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